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Abstract of DEI 9940007 

The invention relates to a method and a device 
for supporting parking of a vehicle using a 
parking assistant. Signals concerning driving 
status supplied by sensors (2) are used to 
calculate a theoretical trajectory in a function 
block. Said trajectory consists of clothoid curves 
and/or a circular curves. Signals supplied by the 
sensors (2), in particular yaw angle signals and 
trajectory signals are used to calculate an actual 
trajectory in a function block (4). Theoretical and 
actual trajectories are then compared. The result 
of said comparison enables real-time calculation 
of the steering angle during the different phases 
of the parking maneuver for which a parameter is 
detennined in a function block (5). Feed-back 
signals supplied by the sensors (2) enable exact 
regulation of the steering angle adopted during 
the parking maneuver. Steering wheel 
movements caused by the driver are tolerated 
but do not have any influence on the steering 
angle. The driver only has to press the 
accelerator and brake pedal to influence the 
speed of the vehicle. 
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Die folgandan Angaban sind dan vom Anmaldar aingaraichtan Untarlagan antnomman 

Prufungsantrag gem. § 44 PatG ist gestellt 

@ Verfahren und Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahrzeugs 

@ Die Erflndung befasst sich mit einem Verfahren und ei- 

ner Vorrichtung zur Unterstutzung des Einparkens eines 

Kraftfahrzeugs, d. h. mit etnem Einparkassistenten. Aus 

von Sensoren (2) gelieferten Fahrzustandssignalen wird 

In einem Funktionsblock (3) eine Soll-Trajektorle berech- 

net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 

gen. Ferner wird auf der Basis der von den Sensoren (2) 

gelieferten Signale, insbesondere eines GienA/inkelsi- 

gnals und eines Wegesignals, eine Ist-Trajektorie in einem 

Funktionsblock (4) berechnet. Dann werden Soil- und Ist- 

Trajektorien verglichen, und das Vergleichsergebnis er- 

moglicht eine mit den Phasen des Einparkvorgangs 

schritthaltende Berechnung des Lenkwinkels, fiir den in 

einem Funktionsblock (5) eine StellgroRe ermittelt wird. 

Von den Sensoren (2) gelieferte Feed-back-Signale er- 
3 moglichen eine genaue Regelung der wahrend des Ein- 
a parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 
a griffe des Fahrers werden toleriert, haben aber keine Aus- 
^ wirkung auf den Lenkwinkel. Der Fahrer muss lediglich 
J Gas- und Bremspedal betatigen, urn die Fahrgeschwin- 
I digkeit des Fahrzeugs zu beeinflussen. 
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fieschreibung 
Stand der Technik 

5 Die Erfindung bctrifft ein Verfahren zur Unterstutzung des Einparkens eines Kraflfahrzeugs, das mil cincm Lenkstell- 
motor und Sensoren zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen 
ausgerustet ist, wobei auf den Befehl eines Fahrers bin eine geregelte UnterstUtzung des Einparkvoigangs mittels des 
Lenkstellers und gestUtzt auf vorbestimmte Fahrzeugdaten und auf Signale der Sensoren ausgeflihrt wird, sowie ein zur 
Durchfuhrung des Verfahrens eingerichtete Vorrichtung. 

10 Bei einem zur Zeit bei der Robert Bosch GmbH in der Entwicklung befindlichen elektronischen Lenksystem wird 
durch einen am Lenkgetriebe der Vorderrader angebrachten elektronisch geregelten Lenksteller, ausgehend von einem 
von einem Lenkradsensor erfasslen Fahrerlenkwunsch unter Beriicksichtigung von fahrdynamischen GroBen die Quer- 
dynamik durch eine Modifikation des dem Fahrerlenkwunsch entsprechenden Lenkwinkels verbessert, d. h., dass das 
Fahrzeug in fahrdynamischen Situationen stabilisiert wird. Das System weist einen Lenkstelimotor auf, der dem vom 

15 Fahrer gestelUen Lenkwinkcl einen Korrekturwinkel hinzuaddiert. 

Die DE 29 01 504 beschreibt ein Verfahren und eine Vorrichtung zum Einparken von Kraftfahrzeugen, welche mit ei- 
ner reinen Steuerung des Einparkvorgangs arbeitet. Dabei werden keine den Verlauf der Einpark-Trajektorie verandernde 
Feed-Back-Signale beriicksichtigt, sondem statt dessen feste Trajektorien vorgegeben. 

Aus dem Patent FR 2 728 859 ist ein Verfahren und eine Vorrichtung zur Regelung des Einparkvorgangs bekannt. Da- 

20 bei ist aber der Fahrer noch zustandig, um Lenkeingriffe durchzufUhren. Dazu werden Sensoren verwendet, die den Gier- 
winkel und den Lenkwinkel erfassen. Unbcfriedigend ist dabei, dass die Leistung des damit rcalisierten Systems durch 
die relativ groBe Tolzeit des Fahrers bei den Lenkeingriffen beeintrachtigt ist. 

Aufgabe und Vorteile der Erfindung 

25 

Es ist Aufgabe der Erfindung, ein Verfahren und eine Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahr- 
zeugs so zu ermoglichen, dass das Fahrzeug automatisch in die Parklucke lenkt, der Fahrer aber selbst durch Gaspedal- 
und BremspedaleingrifFe die Geschwindigkeit regelt. 

Die obige Aufgabe wird anspruchsgemaJ3 gelost. 
30 GemaB einem wesentlichen Aspekt ist das die obige Aufgabe losende Verfahren gekennzeichnet durch folgende 
Schritte: 

A Erfassung einer das unterstiitzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines Initia- 
lisierungssignals; 

35 B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens aus 

einem Gierwinkel signal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signalen; 
D Vorgabe einer oder mehrerer Soli-Taj ektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; 
40 E Erfassung einer jeweiligen Ist-TVajektorie, abhangig von den jeweiligen in den Schritten B und C erfassten Si- 
gnalen; 

F Vcrgleich der in Schritt D voi^gegebenen Soll-TVajektoric und der in Schrilt E erfassten Isl-Trajektorie; und 
G Berechnung der jeweiligen StellgroBe fur den Lenkstelimotor aus dem in Schritt F erhaltenen Vergleichsergeb- 
nis. 

45 

Dabei wird das in Schritt B erfasste Wegesignal vorteilhafterweise von einem Weggeber, vorzugsweise von je einem 
an jedem Fahrzeugrad befindlichen RadgeschwindigkeiLssensor, erfasst. Das ebenfalls in Schritt erfasste Gierwinkelsi- 
gnal kann entweder durch einen geeigneten Sensor gemessen werden oder aber aus geeigneten Signalen, bspw. aus der 
Drehrate eines Drehratensensors und/oder aus den Radgeschwindigkeiten, rekonstruiert werden. 
50 Die Umgebungsbedingungen werden in Schritt C vorzugsweise mittels eines Ultraschallsensors erfaBt. Es ist jedoch 
auch denkbar Radarsensoren oder optische Sensoren, z. B. Kameras, einzusetzen. Die in Schritt C erfassten Umgebungs- 
bedingungen konnen die Form oder AusmaBe einer Parklucke angeben. 

Die oder jede in Schritt D vorgegebene Soll-Trajektorie wird bevorzugt aus einem oder mehreren Klothoidbogen und/ 
oder aus einem oder mehreren Kreisbogen zusammengesetzt. Ein Klothoid ist eine ebene Kurve, deren Kriimmungsra- 
55 dius gemaB der Beziehung R = a • a/s (R: Kriimmungsradius; s: Bogenlange; a: Parameter) stetig kleiner wird. 

Um zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu hoch werden, wird die im Schritt E berechnete 
StellgrSBe einer Filterung unterworfen, die abrupte Ubergangc an den Ranken der StellgrOBe glattet. 

Eine zur Durchfuhrung des Verfahrens eingerichtete Vorrichtung weist crfindungsgemaB eine Regcl-/ Steucreinhcit, 
die von den Sensoren in Abhangigkeit von der Fahrzeugposition, dem Fahrzustand und den veranderlichen Umgebungs- 
60 bedingungen erzeugten Signale sowie die Fahrzeugdaten empf^gt, Mittel zur Berechnung einer Ist-lYajektorie aus den 
Sensorsignalen und den Fahrzeugdaten. Mittel zum Vergleich der jeweils berechneten Ist-Trajektorie mit einer vorbe- 
stimmten Soll-TYaJektorie und Mittel zur Berechnung einer StellgroBe fUr einen Lenkstelimotor aus dem Vergleichser- 
gebnis auf. 

Die das Verfahren durchfuhrende Regel-ZSteuereinheit kann iiber Filtermittel verfugen oder iiber Filtermiltel mit dem 
65 Lenkstelimotor verbunden sein, so dass die berechnete StellgroBe in der oben beschriebenen Weise gefiltert werden 
kann. 

Das oben spezifizierte Verfahren und die Vorrichtung bieten gegenuber dem Stand der Tfechnik mehrere Vorteile: 
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- Es wird keine echte elektronische Steer-by-Wire-Lenkung benotigt. Der bei dem in der Entwicklung befindlichen 
fahrdynamischen Lenksystem eingesetzte Lenkstellmotor ist ausreichend, da er automatische, genaue und sehr 
feine Lenkeingriffe ermoglicht. 

- Die verwendeten Sensoren enriGglichen eine genaue Berechnung der gefahrenen Bahnkurve und damit eine ge- 
naue Regelung des Einparkvorgangs mil slandigen Korrekturen und Anpassungen. 5 

- Die Auswahl der jeweiligen Soll-Trajektorie und ihre Kombination aus Klothoidbogen und Kreisbogen ermog- 
licht eine einfache Beschreibung der Thijektorie und eine schnelle Berechnung des Vergleichsergebnisses zwischen 
Ist- und Soll-Trajektorie w^rend des Einparkvorgangs. 

- Die durch die Regel-/Steuereinheit ausgefUhrte Regelung ermoghcht ein prazises Mandver und temporSre Ab- 
weichungen von der Soll-Trajektorie, urn den Fahrkomfort zu erhohen. 10 

- Die Filterung erhoht den Fahrkomfort, da sie ruckhafte Bewegungen des Lenkrads glatten kann. 

Die nachstehende Beschreibung beschreibt ein bevorzugtes Ausfiihrungsbeispiel des erfindungsgemafien Verfahrens 
und erlautert gleichzeitig die Durchflihrung durch die erfindungsgemaBe \forrichlung unter Bezug auf die beiliegende 
Zcichnung. 15 

Zeichnung 

Fig, 1 zeigt schematisch Funktionsblocke der erfindungsgemaBen Vorrichtung; 

Fig. 2 zeigt graphisch die geomelrische Grundlage zur Hnnilllung einer Bahnkurve iiber den Zusammenhang zwi- 20 
schen dcm Krummungsradius R, dem Winkcl 8 und dem Weg s; 

Fig. 3 zeigt graphisch ein Klothoid als ein Kurve, deren Kriimmung c(s) sich linear mit dem Weg s verandert; 

Fig. 4 veranschaulicht in einer ebenen Darstellung eines Kraftfahrzeugs GroBen, die zur Bestinrunung der Klothoidbo- 
gen dienen; 

Fig. 5 erlautert graphisch eine TVajektorie und einen Lenkwinkel fUr einen Fall, wo eine Fahrt am Lenkeinschlag not- 25 
wendig ist; 

Fig. 6 zeigt graphisch eine TVajektorie und einen Lenkwinkel fur einen Fall, wo keine Fahrt am Lenkeinschlag not- 
wendig ist; 

Fig, 7 zeigt eine mit dem dargestellten Algorithmus erzielle Einpark-TVajektorie. 



Ausfiihrungsbeispiel 
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Das im nachfolgenden Text dargestellte Ausfuhrungsbeispiel eines erfindungsgemaBen Verfahrens zur Unterstutzung 
des Einparkens eines Kraftfahrzeugs und einer zur Durchflihrung des Verfahrens eingerichteten Vorrichtung (kurz: Ein- 
parkassistent) verwendet insbesondere folgende Sensoren: 35 

- Ultragschallscnsorcn zur Erfassung der Umgebungsbedingungen; 

- aktive Radgeschwindigkeitssensoren, die Radgeschwindigkeitssignale bis zum Stillstand des Fahrzeugs liefem; 

- einen Lenkwinkelsensor; 

- einen Drehralensensor, mit dem Signale uber die Giergeschwindigkeit erfassbar sind; und 40 

- (optionell) einen Querbeschleunigungssensor. 

Es ist denkbar, in einem anderen Ausfuhrungsbeispiel der vorliegenden Erfindung einen oder mehrere der beispielhaft 
angeflihrten Sensoren wegzulassen, entweder weil das erfindungsgemaBe Verfahren auch ohne das von dem entsprechen- 
den Sensor geiieferte Sensorsignal voll funktions^ig ist, oder weil das Sensorsignal aus anderen Sensorsignalen rekon- 45 
struiert werden kann. Welche Sensoren zur Durchflihrung des erfindungsgemaBen Verfahrens tatsSchlich eingeseizt wer- 
den kann von einem Fachmann anhand seines Fachwissens im Einzelfall enLschieden werden. Es ware es bspw. denkbar, 
auf einen Drehralensensor zu verzichten und das Drehratensignal aus anderen Sensorsignalen zu rekon struieren. 

Fig. 1 zeigt Funktionsblocke des Einparkassistenten. Aus dem Block 1 stehen Fahrzeugdaten zur Verfugung. Bei- 
spielsweise ist der Block 1 ein Speicher, in dem die Fahrzeugdaten abgespeichert sind. Eine alternative Moglichkeit ist 50 
ein Regel-/Steuerwerk, das die Fahrzeugdaten enthalt. Der Block 2 ist der Sensorblock, der die oben erwahnten Sensoren 
umfasst. Der Funktionsblock 3 berechnet die Soll-TVajektorie in der weiter unten beschriebenen Weise und erhalt dazu 
die Fahraeugdaien aus dem Block 1 und die Scnsorsignale aus dem Block 2. 

Ein zur Ermittlung der Ist-Trajektorie vorgesehener Funktionsblock 4 erhalt ebenfalls die Fahrzeugdaten aus dem 
Block 1 und die Scnsorsignale aus dem Block 2 als Eingangssignale. Insbesondere ist der Drehratensensor zur Rekon- 55 
struktion des Gierwinkels wichtig. Altemativ kann der Gierwinkel auch durch einen entsprechenden Gierwinkelsensor 
gemessen werden. 

Die im Block 3 vorgcgcbenc Soll-TVajektoric und die im Block 4 cnnittclte Ist-Trajektorie werden in einem Vcrglei- 
cher 8 verglichen. Aus dem Vergieichsergebnis und aus Signalen der Blocke 1 und 2 berechnet der Funktionsblock 5 die 
SlellgrOBe. Der Vei;gleich zwischen den Soli- und Ist-Trajektorien ermoglicht eine genaue Regelung des Lenkwinkels 60 
mitlels der im Block 5 berechneten StellgroBe. Diese Regelung ist mdglich, da die Lenkeingriffe von einer Regel-ZSteu- 
ereinheit ausgefuhrt werden. Die im Funktionsblock 5 berechnete StellgroBe wird im Funktionsblock 6 gefiltert, Diese 
Filterung bewirkteine Giattung derFlanke der StellgroBe und erreicht damit, dass die l^nkbeschleunigung und der Ruck 
am Lenkrad nicht zu hoch werden. AuBerdem werden dem Funktionsblock 6 auch Fahrzeugdaten aus dem Block 1 zu- 
gefuhn und dort gefiltert oder in die Filterung der StellgroBe mit einbezogen. 65 

In dem Vergleicher 8 konnen neben der Ist- und der Soll-TYajektorie auch Fahrzustandssignale, bspw. die Orientierung 
des Kraftfahrzeugs, miteinander oder mit den Fahrzeugdaten verglichen werden. Der Funktionsblock 7 reprasentiert ein 
Stellglied, das als ein lenkstellmotor ausgebildet ist. Die Sensoren und der lenkstellmotor konnen Ibil eines fahrdyna- 
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mischen Lenksystems des Kraftfahrzeugs sein. Die zusatzlichen Kosten fUr eine erfindungsgem^Be \brrichtung in einem 
Kraftfahrzeug konnen so auf ein Minimum redzuiert werden. 

Die oben bezogen auf Fig. 1 beschriebenen Funktionen des Einparkassistenten konnen von einer Regel-ZSteuereinheit, 
2. B. einem ohnehin im Fahrzeug vorhandenen Fahrzeugrechner ausgefiihrl werden. 

Nachstchcnd werden untcr Bczug auf die Fig. 2 und 3 die geomctrischen Grundlagen zur Ermittlung cincr IVajektorie 
auf der Basis eines Klothoidbogens beschrieben. 

In Fig. 2 ist graphisch der Zusammenhang zwischen dem Kriimmungsradius R, dem Winkel 6 und dem Weg s einer 
beliebigen Bahnkurve veranschaulicht. Fig, 2 zeigt, wie der Winkel 8 sich mit der Anderung des Wegs s in AbhSngigkeit 
vom Krummungsradius R verhalt. Die Krummung c(s) ist mit Gleichung 1.1 gegeben: 
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C{S) = 



de 

ds 



Gl. 1.1 



Der Winkel 6 berechnet sich aus dem Weg s anhand der folgenden Gleichung: 

Gl. 1.2 



20 B{sh9,^]^'ds 



Diese Gleichung laBt sich mit Hilfe der Gleichung 1.1 wie folgt ausdrucken: 
f 



${s)^et-^je{s)'ds 



Gl. 1.3 



Aus dem Winkel 6(s) werden die kleinen Anderungen (dx, dy) der kartesischen Koordinaten (x, y) berechnet: 



dx(s) 

dy{s) 



cos (6) 

sin (e) 



ds] 

dsl 



Gl. 1.4 



Die Kcxjrdinaten (x, y) werden aus der Gleichung 1 .4 abgeleitet: 



WO], 



Gl. 1.5 
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Die allgemeine Gleichung 1 .5 wird fUr den speziellen Fall der Klothoide vereinfacht. Die Klothoide ist eine Kurve, de- 
ren Krtimmung c(s) sich linear mit dem Weg s verMndert. Diese Kurve wird auch als Comu-Spirale (siehe Fig. 3) be- 
zeichnet. 

c(s) = k • s + co GL1.6 
Aus dem Einsalz der KrOmmung (siehe Gl. 1,6) in die Formel 1.5 ergibt sich: 

\ 



dt 



dt 



Gl. 1.7 



was sich unter den Bedingungen: 
eo = 0,xo = Oco = 0,yo = 0 Ul. 1.8 
6S wie folgt vereinfachen lUsst: 
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Gl. 1.9 



Die Integration der Funktionen sin(u ) und cos(u^) ist nicht trivial. DafUr wird die Reihenentwicklung der trigonome- 
irischen Funktionen angewandt. 



s 

I 



2 



In \ 



R-0 



(2n) 



dt 



- (H 



Gl. 1.10 



Unter bestimmten Bedingungen von Konvergenzen der Reihen (Gl 1.10) kann die Reihenfolgc der Summe und der In- 
tegration invertiert werden. Diese Bedingungen sind in dem vorliegenden Ausfuhrungsbeispiel (GL 1.10) erfiillt. 



n-O 



|(_i)".Ll__J_.^, 



(2n) 



(2rt + l) 



Gl. 1.11 



DieGleichung (1.11) ISsst sich wie folgt transformieren: 



.v(^)- 



ks 



4n*\ 



k' 5 



Gl. 1.12 
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685440 

r 



3 42 1320 75600 



6894720 



Gl. 1.13 
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Die Gleichung 1.13 dient dazu, bedeutende Punkte der TVajektorie schnell zu berechnen. Im folgenden Abschnitt wird 
das Verfahren angewandt, um eine Einpark-lYajektorie zu berechnen. 

Weiterhin wird bezogen auf die Fig. 4 bis 7 die Binpark-IYajektone mit Hilfe eines Algorithmus berechnet, der auf der 
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vorangehend erlauterten Gleichung LI 3 beruht. 

Intuitiver Lenkvorgang 

5 Es sei angenommen, dass das zu parkcnde Fahrzeug parallel zu der Parklucke steht. Die TVajckloric in der LMngsrich- 
lung wird passend zu der existierenden Parlducke vorausgesetzt. Intuitiv soli die Einpark-Trajektorie die folgenden Pha- 
sen beinhdten: 

1. Geradeaus rtickw^s fahren, 
10 2. weiterfahren (eventuell langsamer) und das Lenkrad nach rechts bis zu dem Lenkeinschlag drehen, 

3. weiter riickwarts fahren, 

4. Lenkrad nach links bis zum Lenkeinschlag drehen, 

5. weiter riickwarts fahren, 

6. Lenkrad wieder gerade stellen, und 
15 7. das Fahr/eug anhalten. 

Berechnung des Lenkwinkels 

Die oben beschriebenen intuitiven Phasen sollen formalisiert werden. 

20 - Wegen der einfachen Handhabung von Klothoiden wird angenommen, dass die Phasen 2, 4 und 7 Klolhoid-IVa- 

jektorien sind. 

- Wegen der Symmetrie des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 symmelrisch. 

Die Bestimmung der Phase 2 wird anhand der Fig. 4 hergeleitet. Die Klothoide sind durch einen Parameter k be- 
25 stimmt, der auf der Begrenzung des Lenkwinkels und der Fahr- und Lenkgeschwindigkeiten beruht. 

Die Lange der Phase 3 ist so berechnet, dass das Fahrzeug lief genug in die Parklucke fahn. Der Einfluss dieser Langc 
auf die IVajektorie wird anhand der Fig. 6 und 7 dargestellt Insbesondere zeigt die Fig. 6 die Trajektorie des Fahrzeugs, 
wenn die Phase 4 nicht existiert. 

Die wichtigen Punkte fUr die Berechnung der Thijektorie sind in den Fig, 5 und 6 mil den Buchstaben A, B, C. D, E, F, 
30 G, R gekennzeichnet. 

In Fig. 4 ist schematisch bei einem Fahrzeug mil eingeschlagenen Vorderradem der sich ergebende Radius R = l/c(s) 
und der Lenkwinkel 5(s) dargestellt. Die Klothoide ergibt sich zu 



35 



40 



45 



c(s) = k • s + co Gl. 2.1 

Der Ackermannwinkel ist 
5(s) = arctan[L • c(s)] Gl. 2.2 




Gl. 2.3 



Gl. 2.4 



50 Dies ergibt 
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3*^'' = — • tan 
k 

Der Lenkwinkel ergibt sich zu: 
L-C 



Gl. 2.5 



L-k-v 



Gl . 2 . 6 



6 = 



l+[L-c]' l+[L-c]' 
Daraus erhalt man den flir die Klothoide bcstimmenden Parameter: 

^ max 



k = 



Gl. 2.7 



Dabei findet eine Begrenzung der T^nkwinkelgeschwindigkeit 5 < 6m"". des Lenkwinkels 5 < 5v"" und der Fahr- 
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geschwindigkeit v < v™" statt. Das Ergebnis des Einparkvorgangs mil dem zuvor erlauterten Algorilhmus ist in Fig. 7 
dargestellt, welche in einem x-y-Koordinatensystem eine beispielhafte Einpark-TVajektorie und den zugrundeliegenden 
Soll-Lenkwinkel veranschaulicht. 

Um die Steuerung im Fahrzeug zu programmieren, wird der gefahrene Weg benotigt. Im Fahrzeug wird dieser Weg 
mit aktiven Radgeschwindigkeitssensoren oder in vereinfachtcr Form mil Hilfe eines Weggebers gemesscn. Die Radge- 5 
schwindigkeitssensoren konnen die Radgeschwindigkeit bis zur Geschwindigkeit Null prazise erfassen. 

Bei dem oben beschriebenen System darf der Fahrer wahrend des Einparkvoigangs Lenkeingriffe durchfiihren. Diese 
Lenkeingriffe haben aber keinen EinfluB auf das Manttver. Fails beim Einparken ein Hindemis im Wege steht, soli der 
Fahrer bremsen und den Einparkvorgang stoppen. Da der Lenkradwinkel mit dem zugrundeliegenden Lenksystem sea- 
son sch erfasst wird, werden die Fahrereingriffe am Lenkrad durch den Lenkstellmotor wahrend des Einparkens kompen- 10 
siert. Diese Vorgehensweise ermoglicht, dass der Fahrer u-otzdem das Gefiihl hat, den Einparkvorgang selbst zu steuem 
und sich deshalb wohl fiihlt. 

Aufgrund der vom Drehratensensor gelieferten Signale wird der Gierwinkel berechnet. Bei hochdynamischen Fahr- 
manovern kann diese Berechnung u. U. zeitlich problematisch sein. Beim Einparken treten dagegen in der Regel keine 
Schwicrigkeilcn auf, da sich die Fahi^eschwindigkeil. und die Dynamik des Fahmianovers in Grenzen halt. 15 

Somit ermoglicht der Einparkassistent iiber die Berechnung des Gierwinkels eine echte Regelung des Lenkwinkels 
durchzufiihren, damit die Fahrzeugorientierung dem erwarteten Verhalten entspricht. Mit dieser Regelung konnen Feh- 
ler, die zu einer Abweichung zwischen den gefahrenen und der berechneten TVajektorie fuhren konnen, wie bspw. Fehler 
in der Lenkanlage oder unterschiedliche Reibungen, korrigiert werden. 

Da der Sprung des dem Lenkstellmotor als SlellgroBe zugefuhrten Signals zwischen den Phasen, in denen der Jjcnk- 20 
winkel konstant ist (Phasen 1, 3 und 5) und den Phasen, in denen sich der Lenkwinkel verandert, zunachst abrupt ist, wird 
die StellgroBe in dem in Fig. 1 gezeiglen Funktionsblock 6 gefiltert, indem die abrupten Sprunge der StellgroBe geglattet 
werden. Dabei kann die StellgroBe gefiltert werden, damit die Lenkbeschleunigung begrenzt ist. Da die Soll-Trajektorie 
un verandert bleibt, konnen Abweichungen von der SoU-TVajeklorie auteten. Es werden also temporare Abweichungen 
von der Soll-Trajektorie geduldet, um ein gleichfbrmiges Fahrmanover zu ermoghchen und um dadurch den Fahrkom- 25 
fort zu erhohen. Die Abweichungen zwischen der Soll-TVajektoric und der Ist-Trajektorie werden im Laufe des Einpark- 
vorgangs durch die Regel-/ Steuereinheit mit Hilfe des erfindungsgemaBen Verfahiens korrigiert. 
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1 . Verfahren zur Unterstutzung des Einparkens eines Kraftfahrzeugs, das mit einem Lenkstellmotor und Sensoren 
zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen ausgeriistet ist, 
wobei auf den Befehl eines Fahrers hin eine geregelte Unterstutzung des Einparkvoigangs mittels des Lenkstellers 
und gestutzt auf vorbestimmte Fahrzeugdaten und auf Signale der Sensoren ausgefiihrt wird, gekennzeichnet 
durch folgende Schritte: 35 

A Erfassung einer das unterstiitzte Einparken initiicrendcn Befehlseingabe des Fahrers und Erzeugung cincs 
Initialisierungssignals; 

B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens 
aus einem Gierwinkelsignai und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signa- 40 

len; 

D Voigabe einer oder mehrerer Soll-'Rijektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den 
Umgebungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs 
angeben; 

E Erfassung einer jeweiligen Ist-Trajektorie, abhangig von den jeweiligen in den Schritten B und C erfassten 45 
Signalen; 

F Vei^leich der in Schritt D vorgegebeneri Soll-Trajektorie und der in Schritt E erfassten Ist-TVajektorie; und 
G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichs- 
ergebnis. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass der Lenkstellmotor und zumindest ein Tbil der Sen- 50 
soren Teil eines fahrdynamischen Lenksystems des Kraftfahrzeugs sind. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass das in Schritt B erfassle Wegesignal von je ei- 
nem an jedem Fahrzeugrad befindlichen Radgeschwindigkei Is sensor erfasst wird. 

4. Verfahren nach einem der Anspriiche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signai von einem geeigneten Sensor gemessen wird, 55 

5. Verfahren nach einem der Anspriiche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signai aus einem oder mehreren in den Schritten B und C anderweitig gemessenen Signalen, insbesondere aus ei- 
nem Drchratensignal oder aus dem Wegesignal, rckonstruiert wird. 

6. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Umgebungsbedingun- 
gen in Schritt C mittels eines Ultraschallsensors erfasst werden. 60 

7. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die in Schritt C erfassten 
Umgebungsbedingungen die Form und/oder AusmaBe einer ParklUcke angeben. 

8. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die oder jede in Schritt D 
vorgegebene Soll-Trajektorie aus einem oder mehreren Klothoidbogen und/oder einem oder mehreren Kreisbogen 
zusammengeselzt werden. 65 

9. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die im SchriU E berechnete 
StellgroBe einer Filterung unterworfen wird, um zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu 
hoch werden. 
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10. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass Lenkeingriffe des Fahrers 
tolerierl werden, aber keinen Einfluss auf den Einparkvorgang nehmen. 

11. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Einparkgeschwindig- 
keit durch Gas- und Bremspedaleingriffe des Fahrers beinflussl und die Lenkwinkel ausschlieBlich durch die Stell- 

5 bcwcgungen des Lcnkstellmotors bewirkt werden. 

12. Vorrichtung zur Durchfuhrung des Verfahrens nach einem der vorangehenden Anspriiche, dadurch gekenn- 
zeichnet, dass die Vorrichtung eine Regel-/Steuereinheit, die von den Sensoren in Abhtogigkeit von der Fahrzeug- 
position, dem Fahrzustand und den verSnderlichen Umgebungsbedingungen erzeugten Signale sowie die Fahrzeug- 
daten empfangt, Mittel zur Berechnung einer Ist-lVajektorie aus den Sensorsignalen und den Fahrzeugdaten, Mittel 

10 zum Vergleich der jeweils berechneten Ist-TVajektorie mil einer vorbestimmten Soll-TVajektorie und Mittel zur Be- 

rechnung einer StellgroSe fiir einen Lenkstellniotor aus dem Vergleichsergebnis aufweist. 

13. Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die Regel-ZSleuereinheit die von den jeweiligen 
Sensoren erzeugten Signale sowie die Fahrzeugdaten von einer anderen Steuer-ZRegeieinheit in dem Fahrzeug emp- 
fangt. 

15 14. Vorrichtung nach Anspruch 1 3, dadurch gekennzeichnet, dass die andere Steuer-ZRegeleinheil als ein fahrdyna- 

misches Lenksystem des Fahrzeug s ausgebildet ist. 

15. Vorrichtung nach einem der Anspriich 12 bis 14, dadurch gekennzeichnet, dass Filtermittel in funktioneller \fer- 
bindung mit der Regel-ZSteuereinheit vorgesehen sind, um die von der Regel-ZSteucieinheit berechnete StellgrdBe 
so zu iiltem, dass die Lenkbeschleunigung und der Lenkruck nicht zu hoch werden. 
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